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INTRODUCTION 


Robotics is expected to play an increasingly important role in future space mis- 
sions as the complexity and the exploitive nature of the missions increase. Ini- 
tially, robot systems are envisioned to perform tasks in space, such as the service 
and repair of satellites (ref. 1). Accomplishing these tasks either remotely (tele- 
operator control) or by onboard computers (machine intelligence) requires some type 
of control logic to maneuver the robot's arm and hand. 

Considering the way people control their arms and hands, one finds that people 
do not consciously control individual joints in commanding hand movements. A method 
of mimicking this type of control in a robot arm is called resolved-rate control 
(ref. 2), in which commands to maneuver the robot hand are rotational and transla- 
tional velocities in the hand-axis system. These velocities are then resolved 
analytically into individual joint rates in the robot arm to accomplish the hand 
command . 

positioning a robot arm with resolved-rate control requires relative joint 
information, which is not always known (or is not available) for commercially avail- 
able robot arms. Hence, a method is needed to ascertain this information without 
having to disassemble these arms. The intent in this paper is to develop a method to 
calculate the relative joint geometry of an assembled robot arm. Specifically, the 
Denavit-Hartenberg parameters (ref. 3), which completely characterize this geometry, 
are calculated. 


ANALYSIS 

The objective of this analysis is to derive equations for calculating the 
Denavit-Hartenberg parameters, which completely characterize the relative joint 
geometry in robot arms. In essence, these parameters locate consecutive joint-axis 
systems with respect to each other, both in position and orientation. 


Robot Arm 

Figure 1 , which is a modification of a figure in reference 4, illustrates a 
robot arm and joint-axis systems. To control the arm in a teleoperator mode using 
resolved-rate control, a distant operator commands translational velocities 
(V x , V Y , and V z ) and rotational velocities ( oj^, oty, and i^y) about the hand-axis 
system. (A list of symbols and abbreviations used in this paper appears after the 
references.) These hand commands are then interpreted (or resolved) in terms of the 
individual joint angular rates (i = 1 , 2, . . . , 6) by using transformation equa- 
tions based on the relative joint geometry. Angular rates and 0g correspond 

to rotating the base of the wrist assembly and the cylindrical portion of the wrist. 


Relative Joint Geometry 

Consider two sequential rotational joints in a robot arm, for instance, joint i 
and joint i + 1 . In figure 2 the geometric relationship between axis systems at 



these joints is completely characterized by the Denavit-Hartenberg parameters, which 
consist of three constant parameters a^, , and r^ and a variable joint rota- 

tional angle 0|. By definition, joint rotations are always about the Z-axis. The 
X^-axis is directed along the common normal from to Z^. For clarity, the 

Y^- and Y^_i~axis, which simply complete right-handed coordinate systems at the 
respective joints, are not shown in figure 2. 

In this method of systematically assigning coordinate systems to successive 
joints, the Xg-axis direction for the first joint (or x N for the last joint) is 
chosen arbitrarily. For sliding joints, the joint variable is r^ rather than Q| . 
Only rotational joints are considered in this paper. 

Basic Coordinate Transformation 

The relative joint geometry dictates the basic transformation equations between 
adjacent joints. The coordinates of a point p(x,y,z) with respect to the i 
joint-axis system in figure 2 can be transformed to coordinates with respect to the 
i - 1 joint-axis system by using the relation 
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where A a 1 is the homogeneous transformation matrix from coordinate system i to 
i-1. (See ref. 4, for example.) Equation (1) is equivalent to 
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where the second term on the right-hand side is the location vector of the origin of 
coordinate system i with respect to the origin of coordinate system i - 1 . 
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Problem Statement 


Given a set of coordinates for a point P(x,y,z) with respect to the robot hand 
in figure 1 , the corresponding coordinates of this same point with respect to the 
base coordinate system of the robot arm can be computed as 
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0 6 

where equation (2), with i = 1, 2, ..., 6, supplies the matrices in equation (4). 

Choose point p(x,y,z) as the origin of the robot hand-axis system so that 
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(5) 


Now, place the hand at different locations and measure the hand's location with 
respect to the base coordinate system. The corresponding joint angles for each 
measurement are also recorded (measured or obtained from robot's computer). The 
problem is to use these data to calculate the parameters a^ , a.j_ , and r^ of the 
robot arm. For the robot arm in figure 1, there are 18 unknown parameters a^ , ce^ , 
and r^ (where i = 1, 2, ..., 6). 


Procedure 

A major task in extracting the relative joint parameters is finding a manageable 
way to look at the problem. The basic idea used in this paper is indicated in fig- 
ure 1 . The first problem is to determine the joint parameters a^ , , and r^ , 

which relate the joint coordinate systems (xQ,yQ,ZQ) and (x^,y^,z^). To do this, fix 
the angle 9^ and vary ©2 while holding all the other joint angles constant. The 
resulting hand positions of the robot arm in base coordinates (xQ,y 0 ,Zg) are then 
used to extract these parameters (a^ , a-] , and r-|). A second problem is to extract 

the parameters a 2< and r 2 / which relate the joint coordinate systems 

( x -|/ y 1 ,z 1 ^ and ( x 2'Y2' z 2 Hence, fix 0 2 and vary 0 3 with all the other joint 
angles held constant. Notice that this second problem would be analogous to the 
first if the hand positions in (x^ ,y^ ,z^ ) coordinates were known. But, since a^ , 
a 1 , and r-j have been computed in the first problem, transformation equations allow 
(x-j/y^z-j) to be computed from (xQ,y 0 ,z 0 ). This process is repeated up the arm. The 
mathematics used to extract the parameters in this process are developed in this 
paper. 


3 


Forward Recursive Transformation Equations 

The coordinates in figure 2 are related by the following scalar transformation 
equations (which may be obtained from eq. (3) or derived from fig. 2): 
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of 
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that is, for each set of joint angles, there are corresponding coordinate positions. 
Recall that a-^, ai , and r^ are constant parameters. For this analysis, equa- 
tions (7) and (8) are expressed in different forms because the r^ in equations (7) 
and (8) is not always computable during the parameter-extraction process. The modi- 
fied forms are 


y i (k) = [y^., OO cos 0^(k) - 


x i _ 1 (k) sin 9^(k)]cos + z*_ 1 (k) sin 


- r* sin 


(9) 


z* (k) 


= [x i _ 1 (k) sin 9[(k) - 
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(1 0 ) 


where 


z*(k) = z^(k) + r* cos 


r* = r. + r 


i-1 


cos a. 


i-1 


(1 1 ) 
( 12 ) 


That equations (9) and (10) are equivalent to equations (7) and (8) is easily veri- 
fied by substituting equations (11) and (12) into equations (9) and (10). 

In this study, the recursive application of equations (6), (9), and (10) has the 
following prerequisites: 

1 . z q = z 0' r 0 = and a 0 = 0 to start the sequential recursive process. 

2. Xq, y Q , and z Q are known values from measurements. 

3. Joint angles 9j are known. 

4. Values of r* sin a^, cos a^, sin a^, and a^ have been calculated. 
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Equations (6), (9), and (10) are later used recursively to transform the 
measurement values xg, yg, and zg to other coordinate systems in the arm. By 
design, r^ does not explicitly appear in these equations. 


Equations for Parameter Calculations 
The scalar components of equation (3) are 
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where, as obtained from equation (11), 

z i-1 (k) = z i-l (k * + r x-1 cos “i-1 (16 

and the r* terms are given by equation (12). Again, k has been introduced to 
label data sets. 

At this point, the objective is to calculate , ai, and r^. Assume that 
x^^k), y^Oc)/ and z i-l ^ have been previously calculated from equations (6), 
(9), and (10). Setting i = i + 1 in equations (13), (14), and (15) gives the 
transformation equations from the i + 1 joint— axis system to the i joint-axis 
system as 


x ± (k) = [x i+1 (k) + a i+1 ]cos 0[ +1 (k) - [y i+1 (k) cos o i+1 

- z i+1 (k) sin a i+1 lsin 0| +1 (k) 

y i (k) = [x i+1 (k) + a i + 1 ] sin 0[ +1 + (y i+1 (k) cos oc i+1 

- z i+1 (k) sin a^ +1 lcos ^l+i ^ k ^ 

z*(k) = y i+1 (k) sin a i+1 + z i+1 (k) cos oc i+1 + r* +1 

With a substitution of equations (17) and (18), equations (13) and (14) may be 
expressed as 


x i-1 (k) 


[ c 0 + c 1 cos 0[ +1 (k) - c 2 sin 0[ +1 (k) ]cos 0|(k) 
- [c 3 sin 9| +1 (k) + c 


( 20 ) 


4 cos 0[ +1 (k) - c 5 ]sin 0|(k) 
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f 




[cq + c 1 cos 0| +1 (k) - C 2 sin 9^ +1 (k) ]sin 0|(k) 

+ [c 3 sin 0[ +1 (k) + c 4 cos 0| +1 (k) - c 5 ]cos 0|(k) 


(21 ) 


where 
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and where k has been dropped in equations (22) to (27) because of the important 
assumption that all joint angles, except for 6 i +1 (k) and possibly 0 |(k), are held 
fixed at arbitrary values (perhaps convenient for making measurements) . With this 
assumption, no joint angle above 0 ! +1 is varied. Consequently, x^ + 1 , Yi+i , and 
z i+1 remain constant. In addition, since the joint parameters a^, ai , and r-^ 
are constant, it follows that equations (22) to (27) represent constants. At this 
point, depending on what angles are physically attainable by the robot arm under con- 
sideration, equations ( 20 ) and ( 21 ) may be handled in different ways to calculate the 
constants cq to C 5 . 


Parameter Solution Approach 

The basic procedure is explained by letting 0|(k) = 180° to simplify equa- 
tions ( 20 ) and ( 21 ) to 

(28) 

(29) 

(30) 


Xi_ 1 (k ) = -Cq - c 1 cos 0| + 1 (k) + c 2 sin 0 | +1 (k) 

y i -1 OO = c 5 “ c 3 sin ®i+1 ^ ~ c 4 cos ®l+i 

First, consider equation (28). Again, for the sake of discussion, let 
0^ + 1 (1) = 0°. Then, with k = 1, equation (28) becomes 

x i- 1 ^ 1 ^ = _c 0 “ C 1 


a 
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Let 0^ +1 (2) = 180° in equation (28) to get 


x i-1 * 2 ^ = _c 0 + C 1 


( 31 ) 


Adding equations (30) and (31) yields 


'o = - ; [x i-i (1) + x i-i (2)] 


(32) 


which is the value of a^ in equation (22) . Subtracting equation (30) from equa- 
tion (31) produces 


= " 2 [x i-1 (1 } " x i-1 (2) ] 


(33) 


Then, from equation (28), 

c 2 = [x i _ 1 (k) + c 0 + c 1 cos 0| +1 (k) ]/sin 0£ +1 (k) (34) 

where cq and c-j are now known and 0| + - (k) is any attainable angle as long as 
sin 9| + i (k) * 0. For example, 9{+i (k) in equation (34) may be selected as 120°. 
Analogously, from equation (29), 


: 5 = ; [y i-i (1) + y i-i (2) ] 


(35) 


c 4 = " J [y i-1 (1) " y i-1 (2)] 

c 3 = -[y^^k) “ c 5 + c 4 cos 0| +1 (k) ]/sin 0[ +1 (k) (sin ©i + i (k) * 0) 

Determination of cos ati.- If c-| ^ 0 in equation (25), 


c 3 


(36) 


(37) 


( 38 ) 
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or, if C 2 # 0 in equation (26) 


c 4 

cos CE. = — (39) 

c 2 


In actual computations, if 1 03 1 < |c-j j , then equation (38) is used; otherwise, 
unless c-j = C 2 = 0, equation (39) is applied. 

Deflected extension att ached to hand of robot arm.- The situation wherein both 
c-j =0 and C 2 = 0 is avoidable. For example, an extension can be attached to the 
hand and deflected to vary the constant value of x-^+i in equation (23) so that 
c-) # 0. If an extension is used, measurements are made relative to a point on the 
extension rather than on the hand. The extension length or orientation need not be 
known in this process. 

Equations (32) and (33) and equations (35) and (36) change if 0 ^ +1 takes on 
values other than 180° and 0°. With choices of which allow solutions, a 

generalized matrix-inverse computer routine will furnish the solutions and, at the 
same time, provide a single common solution routine for all the legitimate cases. 

Determination of sin ai.- For convenience, equation (15) is expressed as 


z|_1 (k) = d Q y^k) + d 1 (40) 


where 


d Q = sin (41) 

d 1 = z i (k) cos aj_ + r* (42) 


Equation (40) is a straight-line equation with ordinate (k) and abscissa 

y^(k). The constant slope of this line is d Q and the ordinate intercept is d 1 . 
The coordinate z^(k) in equation (42) is constant in the parameter-calculation 
procedure in this paper, as can be shown with equations (19) and (11). The two 
constant parameters dg and d-j in equation (40) can be determined by using two 
known points on the line, that is, a combination of values of z *_i (k) and y^(k) 
corresponding to two different values of ®i+i (k) . The y^(k) value will vary 
according to equation (18), which may be rewritten as 


y^(k) = c .j sin 0 | +1 (k) + c 2 cos 9 | +1 (k) (43) 

The value of z*_ 1 (k) results from a recursive process using equation (10). 
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Determination of ai«- This constant joint parameter is computed as 


ct^ = tan ^sin a^/cos a^) 


( 44 ) 


where sin is given by equation (41) and cos is given by equation (38) 
or (39) . The correct quadrant for is readily ascertained from the signs 

of sin and cos a^. Actually, sin ce^ and cos a ^ are needed in the trans- 
formation equations rather than itself. 

Determination of r* sin A value for r* sin is needed in using the 

recursive equation (9). Toward this end, multiply equation (15) by sin q and 
rearrange as follows: 

r* sin = z+^OOfsin a^] - y^OO [sin a^] - [z^ sin cos a^l (45) 

The terms in brackets are known from equations (41), (27), and (38) or (39). Hence, 

for values of z*_ 1 (k) and y i (k) , corresponding to a value of 9{ +1 (k), equa- 
tion (45) may be evaluated. For different sets of values of z *_^(k) and y^(k), 
equation (45) may be solved in a least-squares sense. 

At this point, a^ , , sin , cos , and r* sin a.^ are computable. This 

allows the process to be repeated since the right-hand sides of equations (6), (9), 
and (10) are computable. Recall that z*_ 1 in equation (10) is always computed in a 
previous iteration. 

Determination of r*.- The reason for introducing the z* and r* notations 
is to allow continuation of the recursive process even though r^ may not be explic- 
itly known. If sin + 0 , then equations (27) and (41) reveal that 


z 


i 



(46) 


Thus, from equation (42), 


r* = d 1 - z^(k) cos oc^ 


(47) 


where the right-hand side of equation (47) is now computable. On the other hand, if 
sin = 0, equation (15) becomes 


z|_ 1 (k) = z^(k) cos + r* (48) 

and there is no information in equations (13) and (14) about z^(k) to help in elim- 
inating z^(k) from equation (47) . 
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Determination of The calculation of r 4 is best explained by an example. 

Suppose sin a-j * 0, sin a .2 = 0, sin a 3 $ 0, and sin a 4 £0. This means rf, 
r|, and r£ are computable by using equations (46) and (47), but r| is not comput- 
able. As justified by equation (12) and prerequisite (1), write 


r 1 = rf (49) 
r^ + r 2 cos = r 3 “ r 1 cos a 1 cos a 2 (50) 
r 4 = r| - r^ cos a 3 (51) 


In this situation, r-| , r 3 + r 2 cos 0C2» and r 4 are computable. It appears that 
any r 2 and r 3 such that equation (50) holds will give the same results with 
respect to the transformation equations. Indeed, this is meaningful because, in 
locating a point with respect to the robot arm base, two parallel Z-axes will always 
displace the point along the common parallel Z-axis by the sum of the individual dis- 
placements. This same type of analysis holds for other situations. 


Angular Measurements 

The joint parameters a^, oq , and r^ specify the relative locations and 
orientations of the successive joint-axis systems in the robot arm. Until these 
parameters are identified, the locations and orientations of the axis systems are not 
known. Thus, how can the joint angle 0| between the X^_-]-axis and the X-^-axis be 
measured? Essentially all that is known about the robot arm is that the joints 
rotate and that the orientation of the Xg-axis is arbitrary. 

If the rotational axis Z^ lies in or is parallel to a plane that contains the 
Z^_ 1 ~ and X^_-)-axis, then 0.? = 90° by definition of how the joint angle is measured 
in figure 2. This is easily seen in figure 1 by aligning Z-) with Xg . Then 0.?, 
which is the angle between the Xg- and X^-axis, is 90°. 


Displaced Reference Axes 

The location of the robot hand (or an extension) is measured with respect to the 
base of the robot arm, for example, coordinates (x 0 ,yg,zg) in figure 1. However, if 
this is inconvenient, a displaced reference can be used where the base coordinate 
system is treated as just another joint-axis system, the location and orientation of 
which is to be determined with respect to the new displaced reference axes. Alterna- 
tively, knowing the base coordinate system, one can determine its location and orien- 
tation with respect to a more conveniently specified reference axis system. 


EXAMPLE 

The procedure in this paper is applied to compute the relative joint parameters 
of the robot arm in figure 1 . This example is strictly analytical in that no phys- 
ical measurements are actually made. All data are assumed to be without error. 



Generating Measurement Data 


For the position of the robot arm in figure 1 it is not possible to fix 0 3 and 
vary 0^ to obtain changes in the location of point H in coordinates (x 2 ,y 2 ,z 2 ) * 

This does not provide enough information for the desired calculations. However, if 
the segment HW is deflected (e.g., 0g is fixed at 90°), sufficient variation does 
result. A similar situation occurs in trying to vary 0g and fix 0g to vary the 
location of point H in coordinates (x^,y^,z^) . But, in this instance, there is no 
segment to deflect. To avoid this circumstance a deflected extension HF is assumed 
to be attached to the hand. Although no difficulty is incurred for the first three 
joints, measurements for these joints are also referenced to point F. 

In figure 1 measurements are assumed to be made to point F, which represents a 
point on an extension attached to the hand of the robot arm. The location and orien- 
tation of F need not be known in a real application where measurements are taken. 

But, for the purpose of calculating what these measurement data should be, the seg- 
ment HF in figure 1 is assumed to lie along the Xg-axis and to have a length of 
6 in. Base coordinates of F are calculated for three sets (k = 1 , 2, and 3) of 
specified joint angles by using the relative joint parameters in table I. These data 
are given in table II and are used as measurement data to extract the relative joint 
parameters . 


Parameter Calculations 

Parameters a^ , , and .- These parameters are calculated by using the 

three sets of data (k = 1 , Y, and 3) for joint 1 in table II. Both 0| and 0^ are 
listed for convenience. Notice that 0!| is fixed at 180° while 0' takes on values 
of 180°, 0°, and 120°. It does not matter what the other joint angles are as long as 
they are constant, but they are chosen as shown. Since i = 1 and 0* = 180°, equa- 
tion (20) becomes 


x Q (k) = -c Q - c^ cos 0J, (k ) + c 2 sin 0^(k) (52) 

Hence, with the three sets of data in table II for joint 1, equation (52) yields 
three equations to be solved simultaneously for Cq, c-j, and c 2 (given in the 
first row of table III). Likewise, equation (21) becomes 

y Q (k) = -c 3 sin 0£(k) - c^ cos 0^(k) + c 5 (53) 

which, with k = 1, 2, and 3, is solved for c^, c^, and Cg. (See table III.) 

Letting i = 1 and substituting equation (43) into equation (40) gives 


z g(k) = d Q [c 1 sin 0^(k) + c 2 cos 0£(k)] + d 1 (54) 

where c.) and c 2 have been calculated. Letting k = 2 and 3 in equation (54) 
results in two equations which are solved simultaneously for d Q and d^ (See 
table III.) 


Values for a^, cos , sin a y and are calculated with equations (22), 

(38), (41), and (44) and are listed m table IV. 

Since d Q = sin t 0, z 1 is computed from equation (46) for i = 1. Like- 
wise, r* results from equation (47). But, since rg = a Q = 0 by assumption, 
r 1 = r*. The values of r^ and r 1 are shown in table IV. 

The value of r* sin a 1 shown in table IV is computed with equation (45) , where 
z 1 sin a 1 is just c^ (eq. (27)). 

Parameters a 2 , a 2' an< ^ r 2 *~ ® ie calculation proceeds as before with measure- 

ment data for joint 2 in table II, except that point F is needed in coordinates 
(x ,y^,z^) rather than coordinates (xp,yQ,z 0 ). The appropriate transformation equa- 
tions are equations ( 6 ), (9), and (10) for i = 1. They are 


x 1 (k) = x Q (k) cos 0 :j (k) + y Q (k) sin 6 } (k) - a., 


(55) 


yj (k) = [y Q (k) cos 0 } (k) - x Q (k) sin 9 ^(k)]cos a-, 
+ z^(k) sin a 1 - rlf sin ^ 


(56) 


z*(k) = [x 0 (k) sin 0 } (k) - y Q (k) cos 0 }(k)]sin a 1 
+ z£(k) cos a-| 


(57) 


At this point, a 1 , cos a 1 , sin a 1 , and rlf sin a-, are known (table IV) and 
z*(k) = z Q by definition. Thus, x.,(k), y.,(k), and z*(k) are computable with the 

0 ^ (k) values for i = 2 in table n. 

Let i = 2 in equations (20), (21), and (40) to get the following equations: 


x 1 (k) = -Cq - c 1 cos 9 ^(k) + c 2 sin ©^(k) 


(58) 


y^k) = -c 3 sin 9^(k) - c 4 cos 0^(k) + c 5 (59) 

zlf(k) = d Q [c 1 sin 9 ^(k) + c 2 cos 0 ^(k)] + d., (60) 


The constant c values are now determined as before with the data in table II for 
k = 1, 2, and 3. These values are shown in table III. Likewise, the subsequently 
calculated relative joint parameters are shown in table IV. Since sin ct 2 = 0, z 2 
cannot be computed with equation (46); therefore, z 2 cannot be used to compute r^ 
in equation (47) . 

Parameters a 3 , a 3 , and rg.- The locations of point F in coordinates 
( x 2 ,y 2 ,z 2 ) are needed for these calculations. To obtain these locations, first apply 
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equations (55), (56), and (57). Then, apply the following set of transformation 
equations (obtained from eqs. (6), (9), and (10) for i = 2): 

x 2 (k) = x.j (k) cos 9£(k) + y 1 (k) sin 9^(k) - & 2 (61 ) 

y 2 (k) = [y 1 (k) cos 9 2 (k) - x 1 (k) sin 0),(k)]cos a 2 

+ z^(k) sin a 2 - r| sin a 2 (62) 

z^(k) = [x 1 (k) sin 0^(k) - y 1 (k) cos 9 2 (k)]sin a 2 + (k) cos a 2 (63) 

where a 2 , cos a 2 , sin a 2 , and ri; sin a 2 have been previously computed and where 
z|(k) is computed with equation (60). 

Let i = 3 in equations (20), (21), and (40) to get the following equations: 

x 2 (k) = — c Q - c 1 cos 9^(k) + c 2 sin 9^(k) (64) 

y 2 (k) = -c 3 sin 9^(k) - c cos 9^(k) + c 5 (65) 

z*(k) = d Q [c 1 sin 9^(k) + c 2 cos 9^(k)] + d 1 (66) 


The constants calculated with these equations and the data in table II for i = 3 
are shown in table III. The results of other calculations are shown in table IV. 
Notice that a combination value of r 3 and r 2 is given. This value is computed 
from equation (12) for i = 3 as follows (eq. (50)): 

r 3 + r 2 cos oc 2 = r* - r * cos a 1 cos a 2 

This means that as far as the equations are concerned any r 2 and r 2 will give the 
same results as long as they satisfy equation (50) . Notice that the values of r 3 
and r 2 in table I satisfy this equation. 

Parameters a 4 , oc 4 , and r 4 and a^, ctg, and r^.- The same procedure as used 
for i = 1, 2, and 3 is used to calculate the - values shown in tables III and IV. 

Parameters a fi , a fi , and r fi .- If these parameters were calculated in the same 
manner as the other parameters, then some means of introducing a rotational angle Qj 
about Zg in figure 1 would be required. This is not necessary, however, to compute 
ag and rg. To compute these parameters find the location of point H (rather than 
point F) in figure 1 in coordinates (xQ,yQ,Zg) . With previously computed relative 
joint parameters, point H in coordinates (xg,yg,Zg) can be computed by recursively 
solving equations (6), (7), and (8) with i = 1 to 5. The location of point H with 
respect to point H is zero, so (Xg,y 6 ,Zg) = (0,0,0). 
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With i = 6, equations (6), (7), and (8) are 


x g (k) = Xg (k) 

COS 

9g (k) + 

y 5 ( k) 

sin 

06 (k) ‘ a 6 




(67) 

y 6 (k) = [y 5 (k) 

cos 

06 (k) - 

■ x 5 (k) 

sin 

9g(k) ]cos 

“6 + 

(zg(k) 

“ r g ]sin a g 

(68) 

Zg(k) = [x g (k) 

sin 

e*(k) - 

y 5 (k) 

cos 

0 g (k) ] sin 

“6 + 

[ z g (k) 

- r g ]cos ag 

(69) 


From equation (67), 


a g = -x g (k) + x 5 (k) cos 9£(k) + y 5 (k) sin 9g(k) (70) 

Add equation (68), multiplied by sin ag, to equation (69), multiplied by cos ag/ to 
obtain 


r g = z g (k) - y g (k) sin a g - z g (k) cos a g (71) 

With Xg = yg = Zg = 0, equations (70) and (71) are simply 

a g = -x 5 cos 0g(k) - y 5 sin 8g(k) (72) 

r g = z g (k) (73) 


where xg, yg, and zg are coordinates of point H in figure 1. In figure 1, with 
9g = 0, point H has coordinates (xg,yg,zg) = (0,0,6), where the coordinates are in 
inches. Hence, from equations (72) and (73), ag = 0 and r 6 = 6 in. 

Another way to compute ag other than by the method used to compute a-| to as 
is to specify the axis at point H as desired and then physically measure point F in 
coordinates (xg,y 6 ,zg). The coordinates (xg,yg,zg) of point F are computed by using 
the recursive transformation equations. Then, equations (68) and (69) provide two 
simultaneous equations in two unknowns, sin ag and cos ag. The value of rg 
is given by equation (73) as the zg coordinate of point H. Hence, tan ag 
and then ag can be computed. For example, let point F be moved to lie along the 
Zg-axis in figure 1 . Thus, the coordinates of this new point F location are 
(xg,yg,zg) = (0,0,6) and (xg,yg,zg) = (0,0,12) in inches. With these coordinates 
and rg = 6 in., equation (68) becomes sin ag = 0 and equation (69) becomes 
cos ag = 1 . Therefore, tan ag = 0 and ag = 0. 

As expected, a comparison of tables I and IV shows agreement between the 
calculated and exact values of the relative joint parameters a^, ai, and r^ 

(i = 1, 2, ..., 6) when simulated perfect measurement data are used. 


CONCLUDING REMARKS 


If an operator remotely controls the hand of a robot arm by commanding transla- 
tional and rotational rates about the hand axes, then these rates must be resolved 
mathematically into joint rates along the arm to effect these commands (resolved-rate 
control) . This resolution depends on the location of the joints relative to each 
other. This information is usually not available or is difficult to measure for 
assembled commercially available robot arms. But, in teleoperation studies involving 
the control of these arms by resolved rate, this information is required. 

This paper presents a theoretical method to compute the relative joint param- 
eters of assembled robot arms. The idea is to measure locations of the robot's hand 
for different joint angles and to then ascertain the parameters mathematically using 
these measurements. The method is illustrated for a six-degree-of -freedom robot 
arm. Calculated data agreed perfectly with measurement data. 


Langley Research Center 

National Aeronautics and Space Administration 
Hampton, VA 23665 
March 28, 1983 
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SYMBOLS 


^i-1 homogeneous transformation matrix from coordinate system i to i - 1 

a. length of common normal between Z. „ and Z. 

1 1-1 1 

c_,c . , . . . ,c r constants in parameter-extraction process (see eqs. (22) to (27)) 

d^jd^ constants in parameter-extraction process (see eqs. (41) and (42)) 

i integer indicating the ith joint axis or parameters associated with this 

axis 

k integer argument for labeling corresponding measurement data 

N number of joints or joint-axis systems in robot arm 

P(x,y,z) point in Cartesian coordinates 

r relative distance between coordinate system i - 1 and i along Z. 

l i-1 

r* constant defined to eliminate explicit dependence on r^ in parameter- 

extraction process 

V ,V , V translational velocities of robot's hand 

X Y Z 

X, Y, Z coordinate axes 

X. axis directed along common normal between Z^ ^ and Z^ (see fig. 2) 

Y. axis directed to complete right-handed-axis system with X^ and Z^ 

Z. axis of rotation of joint i-1 
l 

x,y,z coordinates along X, Y, and Z 
x.,y.,z. coordinates along X., Y. , and Z. 

i ,jr i' l ill 

x. (k) ,y . (k) , z . (k) coordinates associated with data set k 

l l l 

z*(k) new variable which results when r* is introduced into the parameter- 

i . i 

extraction process 

a angle between Z. and Z. , measured positive counterclockwise about X. 

i y i-I i i 

9. joint angle with initial value corresponding to position of robot arm in 
figure 1 

9'. joint angle between X i _ 1 and X i , measured positive counterclockwise 
1 about (see fig. 2) 

9Mk) joint angle 9^ associated with data set k 

o> ,w rotational velocities of the robot's hand 
X Y Z 
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Abbreviations: 


NO neck-to-base length 

SN shoulder- to-neck length 

ES elbow-to-shoulder length 

WE wrist-to-elbow length 

HW hand-to-wrist length 

HF hand-to-f inger (or extension) length 

Use of a dot over a symbol indicates first derivative with respect to time. 



TABLE I.- ASSUMED RELATIVE JOINT PARAMETERS 


[From ref. 4] 


Joint, 

i 

a i ' 
deg 

a i ' 
in. 

r i' 

in. 

ei, 

deg 

1 

90 

0 

a 26 

0 1 + 180 

2 

0 

b 1 7 

c 6 

e 2 + 90 

3 

90 

0 

0 

e 3 + 90 

4 

90 

0 

d 1 ? 

0 4 + 180 

5 

90 

0 

0 

e 5 + iso 

6 

0 

0 

e 6 

06 


a Neck-to-base length (NO) . 
b Elbow-to-shoulder length (ES). 
c Shoulder-to-neck length (SN). 
^Wrist-to-elbow length (WE) . 
e Hand-to-wrist length (HW). 



TABLE II 


ASSUMED MEASUREMENT DATA USED TO CALCULATE RELATIVE JOINT PARAMETERS 
















Coordinates of 

Joint, 

i 

Data 

index, 

k 



9 i' 

deg 




0jy deg 



point 

F in fig. 1 , 
in. 



6 1 

0 2 

0 3 

0 4 

% 

0 6 

0 i 

0 2 

0 3 

0 4 

0 5 

0 6 

x 0 

*0 

z 0 

i 

1 

0 

90 

0 

0 

0 

0 

180 

180 

90 

180 

1 80 

0 

40.00 

6.00 

20.00 


2 

0 

-90 

0 

0 

0 

0 

180 

0 

90 

180 

180 

0 

-40.00 

6.00 

32.00 


3 

0 

30 

0 

0 

0 

0 

180 

120 

90 

180 

180 

0 

25.19 

6.00 

57.64 

2 

1 

0 

90 

90 

0 

0 

0 

180 

180 

180 

180 

180 

0 

11.00 

6.00 

3.00 


2 

0 

90 

-90 

0 

0 

0 

180 

180 

0 

180 

1 80 

0 

23 .00 

6.00 

49.00 


3 

0 

90 

30 

0 

0 

0 

180 

180 

120 

180 

180 

0 

33.91 

6.00 

9.30 

3 

1 

0 

0 

90 

0 

0 

0 

180 

90 

180 

180 

180 

0 

23.00 

6.00 

37 .00 


2 

0 

0 

90 

-180 

0 

0 

180 

90 

180 

0 

180 

0 

23.00 

6.00 

49.00 


3 

0 

0 

90 

-60 

0 

0 

180 

90 

180 

1 20 

180 

0 

23 .00 

.80 

40.00 

4 

1 

0 

0 

0 

0 

0 

0 

180 

90 

90 

180 

180 

0 

6.00 

6.00 

66.00 


2 

0 

0 

0 

0 

-180 

0 

180 

90 

90 

1 80 

0 

0 

-6.00 

6.00 

54.00 


3 

0 

0 

0 

0 

-60 

0 

180 

90 

90 

180 

120 

0 

-2.19 

6.00 

68.19 

5 

1 

0 

0 

0 

0 

0 

180 

180 

90 

90 

180 

180 

180 

-6.00 

6.00 

66.00 


2 

0 

0 

0 

0 

0 

0 

180 

90 

90 

180 

180 

0 

6.00 

6.00 

66.00 


3 

0 

0 

0 

0 

0 

1 20 

180 

90 

90 

180 

180 

1 20 

-3.00 

11.19 

66.00 

6 

1 

0 

0 

0 

0 

. 0 

0 

180 

90 

90 

180 

180 

0 

a o 

a 6 . 00 

PJ 

<7> 

• 

O 

O 


Coordinates of point H in figure 1 , 
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TABLE III.- CALCULATED CONSTANTS 


Joint, 

i 

Constants in parameter-extraction process from simulated measurements for - 

c Q , in. 

c 1 , in. 

O 2 / in • 

c^, in. 

c 4 , in. 

c 5 , in. 

^0 * 

d 1 , in. 

i 

0 

40 

60 

6 

0 

0 

1 

26 

2 

17 

6 

-23 

0 

6 

-23 

0 

6 

3 

0 

-6 

0 

23 

0 

0 

1 

6 

4 

0 

6 

-6 

0 

0 

0 

1 

17 

5 

0 

6 

0 

6 

0 

0 

1 

0 


TABLE IV.- CALCULATED CONSTANT PARAMETERS ASSOCIATED WITH ROBOT ARM 


Joint, 

i 

a^ , in. 

cos OCi 

■ 

OCi, de< ? 

r*, in. 

r if in. 

r* sin in. 

1 

0 

0 

1 

90 

26 

26 

26 

2 

1 7 

1 

0 

0 


a 6 

0 

3 

0 

0 

1 

90 

6 

6 

4 

0 

0 

1 

90 

17 

1 7 

17 

5 

0 

0 

1 

90 

0 

0 

0 

6 

0 

1 

0 

0 

6 

6 

0 
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Figure 1.- Robot arm and joint-axis systems. 
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